from piper_sdk import C_PiperInterface
import sys
# 测试代码
if __name__ == "__main__":
    # get can name from args
    can = sys.argv[1]
    piper = C_PiperInterface(can)
    piper.ConnectPort()
    piper.MotionCtrl_1(0x02,0,0)       #恢复
    piper.MotionCtrl_2(0, 0, 0, 0x00)  #位置速度模式
    # python piper_reset.py can_left
